//
// File: obstacle_position.cpp
//
// MATLAB Coder version            : 5.4
// C/C++ source code generated on  : 06-Sep-2024 00:58:35
//

// Include Files
#include "obstacle_position.h"
#include <cmath>

// Function Definitions
//
// dob障碍物距离，sio障碍物方向，
//  x机器人x坐标，y机器人y坐标，car_angle机器人方向
// xo障碍物x坐标，yo障碍物y坐标
//
// Arguments    : double dob
//                double sio
//                double x
//                double y
//                double car_angle
//                double *xo
//                double *yo
// Return Type  : void
//
void obstacle_position(double dob, double sio, double x, double y,
                       double car_angle, double *xo, double *yo)
{
  double xo_tmp;
  xo_tmp = sio + car_angle;
  *xo = x + dob * std::cos(xo_tmp);
  *yo = y + dob * std::sin(xo_tmp);
}

//
// File trailer for obstacle_position.cpp
//
// [EOF]
//
